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(54) MANIPULATOR ACTION LIMITING DEVICE 

(57)Abstract: 

PROBLEM TO BE SOLVED: To prevent the interference to peripheral 
equipment by setting a control area to the coordinate value of an arm 
tip, obtaining the distance between the limit area and the arm tip, and 
limiting the moving speed by this distance. 

SOLUTION: The coordinate of an arm tip is operated from each axial 
angle of a slave arm, and the position of a hand tip is operated using the 
coordinate value. The distance L between the hand tip and a set limit 
area Lm is obtained, and attention is paid to the speed Va in the 
direction perpendicular to the limit area out of the components Va, Vb of 
the speed V when the distance L reaches a value below a boundary 
value. The approaching speed is corrected from the relationship between 
the distance L from the limit area Lm and the approaching speed, the 
action command position is corrected from the present position, and the 
action is effected at the corrected action command position. That is, the 
overshoot is prevented by effecting the deceleration in a condition 
where the hand passes the boundary value. 
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